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A DESCRIPTION OF THE THRUSTER ATTITUDE CONTROL 
SIMULATION AND ITS APPLICATION TO THE HEAO-C STUDY 

SECTION I. INTRODUCTION 

During the design and evaluation of a Reaction Control System (RCS) , 
it is desirable to have a digital computer program simulating vehicle dynamics , 
disturbance torques, RCS logic, and control torques. The Thruster Attitude 
Control Simulation (TACS) is just such a computer program. The first part 
of this report is devoted to a description of the TACS, while the remaining 
portion is devoted to the results of the HEAO-C RCS performance study as a 
demonstration of the TACS applicability. 


SECTION II. DESCRIPTION OF THE TACS COMPUTER PROGRAM 


The TACS is a relatively sophisticated digital computer program that 
includes all the major parameters involved in the attitude control of a vehicle 
using an RCS for control. It includes the effects of gravity gradient torque 
and HEAO-C aerodynamic torques so that realistic runs can be made in the 
areas of fuel consumption and engine actuation rates. Also, the program is 
general enough that any engine configuration and logic scheme can be imple- 
mented in a reasonable amount of time; i.e. , a major change is usually im- 
plemented in a few days. 


A. Coordinate Systems 

The TACS uses only two coordinate systems: a vehicle body system 
and a quasi -inertial system. The vehicle body coordinate system has its 
origin at the center of mass of the vehicle with the X body axis along the 

longitudinal axis of the vehicle, the Z body axis normal to the solar panel 

D 

axis in the case of the HEAO, and the Y body axis completes the right-hand 

±> 

triad. The origin at the center of mass of the vehicle was chosen to imple- 
ment the gravity gradient equations in an efficient manner. 



The quasi-inertial coordinate system has its origin at the center of the 
earth. The X inertial axis can be assumed to be inclined 23. 5 degrees from 

the earth's spin vector, while the Y c and Z axes lie in the ecliptic plane. 

o O 

The Y and Z axes have no particular pointing direction, so the time of 

year of the orbit chosen, along with a particular vehicle orientation, is simulated 
by choosing the proper orbital inclination in the quasi-inertial system to give 
the desired orbital parameters. The method works well for runs of a few 
orbits; but if longer on-orbit times were to be studied, a coordinate system 
rotating once a year would have to be added. 


B. Program Description 

The TACS consists of four main divisions: 

1. General Equations 

2. Rotational Dynamics 

3. Vehicle Dynamics 

4. Translational Dynamics 

Although it is not included as a separate division here, the TACS 
initialization procedure to ensure that all variables are initialized is rather 
lengthy and should not be overlooked. A flow chart of the entire program is 
shown in Figure 1 and the equations discussed are shown in Appendix A. It 
is believed that the most convenient way to discuss the TACS will be under the 
four divisions previously mentioned. 


C. General Equations 

There are five equations under this heading and each calculates ele- 
ments that are used in one or more other sections of the program (Appendix A) . 
Inertial position and velocity of the vehicle are calculated by the root-sum - 
square (rss) method for use in several other equations. The gravitational 
acceleration at altitude is calculated for orbital mechanics purposes and the 
final two calculations for vehicle altitude and position angle are performed 
primarily for the programmer's benefit. 
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CALCULATE 



Figure 1. Flow chart for the thruster attitude control simulation, 


































D. Rotational Dynamics 

In this section are calculated the gravity gradient torques, the aero- 
dynamic torques, the thruster torques, vehicle angular acceleration and rites, 
and the direction cosine matrix. The gravity gradient equations were taken 
from Reference 1 where they are derived and explained in detail. The equa- 
tions are valid only if the body coordinate system has its origin at the center 
of mass of the vehicle in orbit. 

The torques caused by RCS engine firings are calculated simply by 
multiplying the thruster force by the corresponding lever arm (s) . Since the 
equations for each axis are therefore relatively simple , it was decided to 
change them for each new engine configuration rather than try to write a 
general expression suitable for all configurations. The resulting savings in 
run time and program complexity more than make up for the small incon- 
venience. 

The aerodynamic torques used in the TACS are valid only for the HEAO; 
vehicles. Therefore, if any other vehicle is studied with the TACS and it is ; 
desired to include aerodynamic torques, the aerodynamic equations will have 
to be rewritten. The aero equations presently in the TACS were taken from 
Reference 2. They are written for the HEAO-A and HEAO-B vehicles, but it 
was felt they would be suitable at least for a preliminary study of the HEAO-C 
vehicle. The main drawback is that the effects of the orbit adjust stage (OAS) 
are not included. The aerodynamic torques are a function of the angle of attack 
and the roll angle so these parameters are fed into a group of aerodynamic co- 
efficient equations derived by a curve fitting procedure. The resulting co- 
efficients are modified according to center of gravity considerations and then 
these body aerodynamic coefficients are used in the aerodynamic equations. 

A more detailed, analysis and discussion of the aero equations can be found in 
Reference 2. 

The various vehicle torques are used to calculate the angular accelera- 
tions on the vehicle. These angular accelerations include equations simulating 
the effects of precession exhibited by a rotating body. The acceleration due to 
each source is integrated to obtain angular rates. Various methods of integra- 
tion are used to produce the highest degree of accuracy. For instance, rec- 
tangular integration is absolutely correct for accelerations due to thruster 
torques whereas forward trapezoidal integration is suitable for the integration 
of accelerations due to gravity gradient torques. The rectangular integration 
is appropriate . since the thruster firings are modeled with a perfect rectangular 
wave form of duration At . 
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Direction cosines rather than Euler angles are used in the attitude 
determination of the vehicle to avoid the 90-degree angular rotation limit in 
one axis. The direction cosines,’ [A] , are illustrated in Figure 2. The rates 
of change of the elements of the direction cosine matrix are determined from 
vehicle angular rates and previously calculated direction cosines. These new 
rates are then integrated to obtain new values for the direction cosines. Since 
the program is digital, a finite At must be used. Thus, there is some in- 
accuracy in obtaining the direction cosine rates to be integrated. Therefore, 
the direction cosine subroutine utilizes a simple ortho-normalization pro- 
cedure to ensure that an overall drift of the direction cosines will not occur. 

A more detailed discussion of direction cosines can be found in Reference 3. 

It should be noted that the elements of the [A] matrix must be initialized 
accurately. 

t ' 

E. Vehicle Dynamics 

The desired attitude of the vehicle is expressed with another direction 
cosine matrix, the attitude control matrix [ C] . By multiplying the transpose 

T 

of the attitude control matrix, [C] , times the direction cosine matrix [A] , 
a third 3x3 matrix, [D] , is obtained. By comparing the elements of this 
matrix with those of a comparable Euler matrix, appropriate terms can be 
chosen and combined to express the attitude errors. These errors are not 
absolutely correct but as the attitude error approaches zero, the deviation 
from the actual attitude error also approaches zero. Hence, for the small 
deadbands normally used during RCS control, the attitude errors generated 
are for all practical purposes correct. 

If an attitude other than inertial hold is desired, the control matrix 
[C] will no longer consist of constant elements. Instead, trigonometric re- 
lationships will have to be used to express the elements. In addition, if the 
vehicle is required to spin about an axis , a spin angle will have to be in- 
troduced to express the desired vehicle attitude at each instant of time. The 
rate at which the spin angle changes will, of course, determine the spin rate 
of the vehicle. 

Once the attitude errors are obtained, they are combined with the 
angular rates using suitable, gains to obtain the control error signals or 
command torques. Presently the TACS uses a constant slope deadband, but 
it would be easy to implement other types of control laws. Using these com- 
mand torques, the engine logic decides which engine or engines should be fired 
for a particular error. The logic equations in Appendix A are expressed only 
in general terms because engine logic normally changes between studies. The 
implementation of a particular logic configuration can be seen in the sample 
printout in Appendix B. The logic is that shown in Figure 3. 
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2 2 Figure 3. A three-axis logic scheme for selecting proper 

thrusters during attitude control. 


F. Translational Dynamics 

Since aerodynamic drag is ignored in the TACS, the only contributors 
to translational motion are thruster firings and gravity. The equations for 
force due to thruster actuations are simply summations per axis of the engine 
thrusting along the axes. Normally the engines are assumed to be aligned 
along the three axes, but if they are skewed at some angle, only a simple 
trigonometric relation needs to be added. These equations are changed for 
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each new engine configuration to reduce program complexity and run time. 
The thruster forces are used to generate body translational accelerations 
which are transformed and combined with acceleration due to gravity to pro- 
duce a total inertial acceleration. These translational accelerations are then 
integrated twice to obtain velocity and position in inertial space. Inertial 
velocity and position are then transformed to velocity and position in the body 
coordinate system. These transformed values are required in the gravity 
gradient and aerodynamic equations. 


SECTION III. HEAO-C PERFORMANCE SIMULATION 


The two primary HEAO-C vehicle requirements placed on the RCS are 
control moment gyro (CMG) momentum de saturation and attitude control. 
CMG desaturation requires by far the largest amount of fuel and is the pri- 
mary driver in the selection of an engine configuration and control law. Since 
some attitude control is required of the RCS (one contingency mode may last 
30 days) , it was decided to perform an analysis from the RCS attitude control 
viewpoint. However, as presently baselined it should be remembered that the 
HEAO-C RCS depends upon CMG desaturation efficiency and not so much on 
performance in the RCS attitude control mode. 


A. Baseline RCS Configuration and Control Law 

The HEAO-C baseline RCS configuration is shown in Figure 4. It 

consists of four reaction engine modules each containing four reaction engines , 

two primary and two redundant. Four engines can control both pitch (rota- - 

tions about Z ) and/or roll (rotations about X ) whereas the other four can 
x> J3 

control yaw (rotations about Y^) and/or roll. The engines are numbered 

according to (1) the quadrant in which they are located, and (2) according to 
the direction they are pointing. Four of the engines have three identifying 
numbers rather than two. This is required since they are located in the same 
quadrant and point in the same direction. The third number is merely the 
quadrant they are nearest (not in) . Hence each engine has its own identity 
and can be distinguished from the other seven. 

Since the configuration lends itself so well to signal mixing, roll is 
mixed in with both pitch and yaw on all eight of the engines as shown in 
Figure 3 (see Figure 4 for the engine nomenclature). The resulting signal is 
routed through the modulators and then to the selected engine(s). 
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Z-PITCH 



HEAO-C baseline RCS thruster configuration. 



A straight line constant gain law was used with a gain ratio of five. 
Unless the roll error is exactly zero, this control law prevents two engine 
burns in a single axis at the same time. This, of course, allows 'onger burn 
times since only one engine will be performing vehicle control at any time. 
The longer burn times result in a higher I and therefore more efficient 

use of the fuel. The signal modulators depicted in Figure 4 are m rely a plus 
or minus deadband device with no attempt being made to enhance t-e signal 
for better efficiency. 


B. Simulation Results 

In all of the cases where the RCS was used for attitude control, the 
worst case orientation for gravity gradient was used. Therefore, the data 
presented depict the worst case fuel consumption and cycle rate in all cases 
unless otherwise noted. 

Table 1 presents the results of the TACS study of the baseline HEAO-C. 
About half of the items listed were analyzed using hand calculations but they 
are included to complete the timeline. The first item studied was the separa- 
tion of the HEAO from the launch vehicle with the resultant vehicle rates in- 
troduced on the HEAO. The TACS was initialized with the vehicle in the 140 by 
250 n. mi. orbit with 3 degree/second rates on all three axes and the HEAO 
was immediately commanded to maintain attitude and null the rates. The fuel 
consumed, 7. 45 lbm, includes that required for returning the vehicle to the 
same attitude as it had at the beginning of the burn, in addition to nulling rates, 
although the attitude hold may not be a requirement for the HEAO. 

The next TACS application involved vehicle control in the insertion 
orbit of 140 n. mi. by 250 n. mi. Although nominally RCS control in this orbit, 
as well as the others, will not be a system driver, the contingency of about a 
30-day stay in the 140 n. mi. by 250 n. mi. orbit will affect fuel consumption 
drastically if attitude is maintained within ±0. 5 degree. The TACS analysis 
in this orbit indicated a fuel consumption rate of 0. 244 lbm/orbit. Hence the 
nominal mission will require a maximum of 1. 09 pounds of fuel in this orbit, 
but for the 30-day stay almost 115 pounds will be needed. The actual require- 
ments should be less than those mentioned since vehicle attitude will vary 
with time; i. e. , the worst case will not be maintained for 30 days. Also, it 
should be noted that a deadband of ±0. 5 degree probably would not be needed 
and could be relaxed during this part of the mission. 
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TABLE 1. SIMULATION RESULTS FOR THE BASELINE HEAO-C 


Event 

Total 

Impulse (lb-sec) 

Fuel Required 
at I =140 sec 
8P 

(lbm) 

Worst Case 
Engine Cycling 
for an Engine 

Comments 

Null 3 degrees/ second 
3 Axes 

1 043.8 

7.45 

30 

Includes Attitude 
Coptnd 

Solar Acquisition 

(90 degrees about X and Y) 

268.0 

1.91 

4 

2 degrees/second 
Maximum Manuever Rate 

Attitude Control In 
140 x 250 n. ml . Orbit 

153. 6 
16 082. 0 

.. j 9 at 4. 5 Orbits 
114.8 at 30 Days 

319 or 
31 500 

0. 244 lbm/Orblt 

QAS Thrust Vector 
Misalignment During 
Burn to 203 x 250 n. mi. 

1 079. 5 

7.71 

150 

7. 5 minute Burn 

Attitude Control in 
205 x 250 n. mi. Orbit 

33. 49 

0. 239 

70 

0. 239 lbm/Orblt 
for 1 Orbit 

QAS Thrust Vector 
Misalignment During 
Burn to 250 x 270 n. ml. 

804. 1 

5. 74 

112 

5. 58 minute Burn 

Attitude Control In 
250 x 270 n. mi. 

51.0 

0.364 

106 

0. 243 lbm/Orblt for 
1. 5 Orbits 

QAS Thrust Vector 

Misalignment During 

Burn to 270 n. ml Circular Orbit 

671 2 

4. 80 

94 

4. 68 minute Burn 

Attitude Control in 
270 n. ml. Orbit until 
CMG'a are up to 
Speed, End of Checkout 
and Acquisition of X-ray 
Reference 

253. 3 

1.81 

• 

451 

0. 245 lbm/Orblt 
for 7. 4 Orbits 

CMG Momentum 
Dumping at 270 n. mi. 

107 767 

769.7 

211 090 

Only 52 750 
Actuations per 
Engine are Expected 

Totals 

112 126. 99 or 
128 055.39 

795. 647 or 
909. 957 

212 428 or 
243 607 
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The engine actuation rate, could be extremely high- in this orbit if the 
30-day stay time is used. Extrapolating the worst case figures gives 31 500 
cycles for one engine which is about one-sixth of the engine's rating. Again it 
must be noted that this is a worst case figure since a deadband of ±0. 5 degree 
was used. If the deadband were relaxed, the actuation rate would decrease 
appreciably. The nominal staytime of 4. 5 orbits requires only 319 actuations 
for a worst case engine, so no problem is anticipated if the nominal mission 
timeline is followed. 

At the end of the stay period.in the insertion orbit, the RCS will be used 
to acquire the proper vehicle attitude for the OAS burn into the 205 by 250 n. mi. 
orbit. The RCS will also be used to maintain vehicle attitude during the OAS 
burn. For both attitude acquisition and burn control, a 1080 lb-sec impulse 
will be required. This impulse determination was made without the use of the 
TACS. 

; 

Once the HEAO has been inserted in the 205 by 250. n. mi. orbit, the 
RCS will be used to maintain attitude control until the next OAS burn and 
nominally should require one orbit. During the orbit, only a 33. 5 lbf-sec . 
impulse will be required. A total of 70 engine actuations will be required for 
the worst case engine. 

After the HEAO has completed one orbit in the 205 by 250 n. mi. orbit, 
it must be positioned for an OAS burn into the 250 by 270 n. mi. orbit. The 
impulse required for attitude acquisition and OAS thrust misalignment manage- 
ment was found to be 804 lb-sec. If a single RCS engine is required to do all 
of the control during the OAS burn, it will be actuated a maximum of 112 times, 
a negligible amount compared to CMG desaturation requirements. 

The vehicle will remain in this orbit for 1. 5 revolutions during which 
time the RCS will require a 51 lb-sec impulse to maintain the HEAO within the 
required deadband. At the end of 1. 5 orbits, the HEAO injection into a 
270 n. mi. circular orbit will require an impulse of approximately 673 lb-sec 
impulse from the RCS. After the HEAO acquires the 270 n. mi. orbit,' the 
RCS may be needed for 7. 4 orbits after which the CMGs will take over attitude 
control. RCS control for 7. 4 orbits will require an impulse of 253 lb-sec. 

The worst case engine can be expected to actuate 451 times during the 7. 4 
orbits. , ! 

These last numbers can be used to obtain a worst case fuel consump- 
tion and actuation history in the case of a failure of the CMG; 253 lb- sec for 
7. 4 orbits gives 34. 22 lb-sec per orbit at 270 n. mi. Since a 2-year mission 
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will have about 11 000 orbits, an impulse budget of 379 842 lb-sec will be 
required. At an I of 140 seconds this indicates a fuel requirement of 

2713 pounds. This number is valid only if the HEAO remains in the worst 
case gravity gradient attitude for the entire mission (an unreasonable criteria) , 
but it does place an upper limit on fuel requirements for a 2-year mission in 
the case of an early CMG failure. Also, the vehicle would be operating in a 
degraded mode as the above figures reflect a deadband of ±0. 5 degree. The 
actuation histqry indicates that 61 actuations may be expected per orbit for a 
single engine as shown in Figure 5. If this number is extrapolated for 2 years, 
677 100 actuations could be expected of a single engine. This exceeds by about 
a factor of four the present cycle lifetime of an engine but it must again be 
remembered that this is a worst case number and would actually be signifi- 
cantly smaller, perhaps even within the engine specifications' 

A single run was made with the TACS to determine if a control system 

using only an RCS would be feasible for HEAO-C. A deadband of ±1 arc min 

was placed on all three axes and a 0. 5-pound thrust level was used for the 

thrusters. This combination produced about 1600 actuations per. orbit which 

would quickly exceed the cycle lifetime of present RC$ thrusters. It was also 

felt that the I would be so low as to preclude the RCS on a fuel weight basis, 
sp 

At this point it was decided to drop any further studies along this line. 

Although CMG momentum desaturation is almost the exclusive RCS 
driver on the HEAO-C, a TACS study could not be performed since TACS 
does not include the necessary CMG equations. An analytical calculation 
showed that about 108 000 lb-sec i.ipu 1 will ideally be required for the 2- 
year mission but the RCS configuration used will determine the actual amount 
of impulse and fuel required. 

C. Alternate System v 

The alternate RCS configuration for HEAO-C is shown in Figure 6. 

The four reaction engine modules are retained from the baseline system but 
they are relocated to the positions shown. For identification; a: two-digit 
number is used for each engine. The first digit of each number gives the 
quadrant the engine is in and the second digit tells the direction in which the 
engine is pointing. 

Two controElaws werd tried for this alternate system. The first, 
shown in Figure 7, proved to be very undesirable frqm both actuation and 
fuel consumption viewpoints. Hence the second law, Figure 8, was devised. 
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Figure 5. Typical thruster actuation history for 'the baseline HEAO-C 
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Figure 6. The alternate thruster configuration for the HEAO-C. 
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Figure 7. An unsuitable control law for the 
alternate HEAO-C RCS. 
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Figure 8. The final control law used in simulating the alternate HEAO-C ECS. 








Pitch and yaw are controlled with the radial engines so there is no roll control 
when either pitch or yaw is being corrected. Roll is controlled with the tan- 
gential engines where two of the four engines available are chosen depending 
on the polarity of the roll error signal. Only one engine is finally used, 
though, depending upon the polarity of any error in pitch or yaw. Hence, 
roll is partially coupled to pitch and yaw in that only one engine will be used 
at any one time for roll control depending on which roll engine of the two 
selected will best help pitch or yaw. Only when the roll error hajs exceeded 
the deadband, however, will a roll engine be actuated. This law proved to be 
much more efficient than the first law tried, therefore, it was used for the 
TACS study of the alternate RCS system. 

The study followed the same timeline as was used for the baseline 
study with the results shown in Table 2. Fuel consumption and actuation 
rates are larger than they were in the baseline system. This was expected 
since the baseline configuration allows single engine burns to efficiently con- 
trol two axes. However, it is felt that the alternate system would be the 
better system for the HEAO-C since long single engine burns would be allowed 
when dumping momentum. A modification to TACS to include the CMG equa- 
tions is being considered and will probably be added at a later date. 


D. Conclusion 

The TACS has been shown to be a valuable tool in the performance 
studies of vehicles using an RCS for attitude control. It has been demon- 
strated that various RCS configurations and logic schemes can be imple- 
mented in a short time so that a detailed tradeoff study can be made of various 
candidate systems. For the HEAO-C in particular, the simulation is very 
comprehensive in that aerodynamic torques are included in addition to the 
gravity gradient torques. However, if aerodynamic torques are desired for 
any other vehicle, the equations for that vehicle will have to be substituted 
for the HEAO-C aerodyanmic equations since the ones now in the TACS are 
applicable only to the HEAO. 

The TACS was used primarily to determine fuel consumption and 
engine actuations. For the alternate system, two control laws were con- 
sidered. The first of these was shown to be somewhat less efficient as com- 
pared to the law finally used. Hence, it is seen that the TACS can be used 
to aid the selection of a particular RCS configuration, choose a control law 
for that configuration, and finally, allow a performance study of the chosen 
configuration. 
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TABLE 2. SIMULATION RESULTS FOR THE ALTERNATE HEAO-C RCS 


Event 

Total 

Impulse (lb-sec) 

Fuel Required 

at I = 140 sec 
sp 

(Ibm) 

Worst Case 
Engine Cycling 
for an Engine 

Comments 

Null 3 degrees/second 
3 Axes 

1 043. 8 

7. 45 

30 

Includes Attitude 
Control 

Solar Acquisition 

(90 degrees about X and Y) 

268.0 

1. 90 

4 

2 degrees/second 
Maximum Manuever Rate 

Attitude Control in 
140 x 250 n. mi. Orbit 

165.9 
17 374. 0 

1. 18 at 4. 5 Orbits 
124. 1 at 30 Days 

675 or 70 632 

0. 263 lbm/Orbit 

OAS Thrust Vector 
Misalignment During 
Burn to 205 x 250 n. mi. 

1 079. 5 

7. 71 

150 

7. 5 minute Burn 

Attitude Control in 
205 x 250 n. mi. Orbit 

36. 55 

0. 261 

146 

0. 261 lbm/Orbit 
for 1 Orbit 

OAS Thrust Vector 
Misalignment During 
Burn to 250 x 270 n. mi. 

804. 1 

5. 74 

112 

5. 58 minute Burn 

Attitude Control in 
250 x 270 n. mi. Orbit 

54.4 

0. 38 

144 

0. 259 lbm/Orbit 
for 1. 5 Orbits 

OAS Thrust Vector 

Misalignment During 

Burn to 270 n. mi. Circular Orbit 

673. 2 

4. 80 

94 

4. 68 minute Burn 

Attitude Control in 
270 n.mi. Orbit Until 
CMGs are up to 
Speed. End of Checkout 
and Acquisition of X-ray 
Reference 

266. 9 

1.90 

1 058 

0. 258 lbm/Orbit 
for 7. 4 Orbits 

CMG Momentum 
Dumping at 270 n. mi. 

107 767 

769.7 

422 180 

Typically 105 545 
Actuations per 
Engine are 
Expected 

Totals 

112 159. 35 or 
129 367. 45 

801. 02 or 
923. 94 

424 593 or 
494 550 
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APPENDIX A 


EQUATIONS DERIVED TO IMPLEMENT THE THRUSTER 
ATTITUDE CONTROL SIMULATION 

0.0 General Equations 

0. 1 R = Vx 2 + Y 2 + Z 2 
s s s s 

0. 2 g = g 0 H E 2 /R g 2 

0.3 h = R - R„ 
s E 

0. 4 V = Vx 2 + Y 2 + Z 2 
s s s s 

0. 5 7j = 2rrt/P 


1.0 Rotational Dynamics 


1. 1 

M = ^ 17 1 -I \ Y Z 

g* R g 5 z yy b b 

+ I 1 
zyl 

( z b- y b) 

1 + 1 X Z - I X Y_ 
1 xy B B xz B B 

i. 2 

M = [/i -I \x z 

gy R s Hx z) b b 

+ 1 ( 

xz\ 

' x b- z b' 
V ) 

\+I X Y_ - I Y_Z_ 
/ zy B B xy B B 

1. 3 

M = rpj F/l -I \x Y 

+ I 1 


| + I Y Z^ - I XZ„ 

gZ R s 1 \ y X / B B 

xy | 

l B B y 

1 xz B B zy B B 

1. 4 

M_, -VL F 
Tx Li x x 




i. 5 

M_ =VL F 

Ty Lj y y 




1. 6 

M_ =Tl F 
Tz z z 
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1. 7 
1 . 8 

1. 9 
1. 10 
1 . 11 
1. 12 


M Ax~2 pV = 2A ^ D ~C. 


s ref ref leg 


M Ay = 2 A re{ D ref C 

“Ax-X’^^C. 


meg 


aeg 


M x M gx + M Tx + M Ax 

M y ~ M gy + U Ty + M a y 

M z ' M g, + m Tz + m Az 


1 . 13 


1. 14 



1. 15 




I -I 
x y 


)* 


<P <P 

X y 




/I 

z 


1. 16 




‘• 1T V/V't 

1.18 « z =/i' 2 dt 

1-19 A„ = . A „0 

y 

!• 20 A 1 2=A 13 0 • -A tl 0 

X z 
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1. 21 


1. 22 

1.23 

1.24 

1.25 

1.26 

1.27 

1.28 

ORTHO 

1.29 

1.30 

1.31 

1.32 

1.33 

1.34 

1.35 

1.36 

1.37 

1.38 


• • • 

A 13 = A H^y “ A 12 ^ x 

• • • 

A 2 i = A 22 $ z “ A23<£y 

• • • 

A 22 = A230 x “ A 2 i0 z 

• • • 

A 23 = A 2 i 0 - A 22 $ x 


A31 = A 32 0 z - A 33 0y 

• • • 

A32 = A 33 0 x - A 31 0 z 


• • • 

A33 = A 3 i 0^ - A 32 ^> x 

A.. = f A. . dt 
13 J iJ 


NORMALIZATION 
A 21 - A 13 A 32 - a 12 a 33 
A22 = AhA 33 - A 13 A 31 
A23 = A 12 A 31 - A lt A 32 
A31 - a 12 a 23 - a 13 a 22 
A32 = A i3 A 21 - a u a 23 
A 33 = AjjA 22 - A 12 A 21 


lTHO t = V A u 2 + A 12 2 + A 13 * 
itho 2 = n/ A 21 2 + A 22 2 + a 23 2 
itho 3 = nTaJTaJTaJ 

t = A. ./ORTHO 
j corrected lj 
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2.0 Vehicle Dynamics 




Cii 

C 12 

C 13 

2.1 

[C] = 

C 21 

C-22 

C 23 



C-31 

C 32 

C 33 


= Control Matrix 


2.2 

[D] = C T A 

2.3 

= 2 ^ D 32" D 23) 

2.4 

= 2 ^ D 13“ D 3l) 

2.5 

^Z~ 2 

2.6 

6 = A ip + A 0 
x Ox x lx X 

2.7 

6 = A n jp + A, 0 
y Oy y ly y 

2.8 

6 -A 0 + A 0 
z Oz r z lz z 

THRUSTER LOGIC 

2.9 

F.. =f (d ,6 ,6 ,e' 


3.0 Translational Dynamics 


3.1 

CXI 

11 

£ 

3.2 

11 

M 

3.3 

F T 2 = 2 F : 
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3 ‘ 4 ' X B - r Tx /m 


Z B * F T 2 /m 



— — 


* 


* 


- - 

3.7 

X 

s 


A n 

A 12 

A 13 


X B 

3.8 

• • 

Y 

s 

= 

A 21 

A 22 

A 23 


• • 
Y B 

3.9 

• • 

Z 

s 

= 

A 31 

A 32 

A 33 


• • 

Z B _ 

3.10 

« 

X = 
s 

P 

: dt 
s 




3.11 

• 

Y = 
s 

P 

' r dt 
s 




3.12 

• 

Z = 
s 

P 

dt 

s 




3.13 

X = 
s 

f X dt 
J s 




3.14 

Y = 
s 

/ Y dt 
J s 




3.15 

Z = 
s 

P 

dt 

s 




3.16 

m 


A u 

A 21 

A 31 


” • ” 

X 

s 

3.17 

• 

V B 

= 

A i2 

A 22 

A 32 


• 

Y 

s 

3.18 

• 

Z B 


A 13 

A 23 

A 33 


• 

Z 

s 

3.19 

'V 


’ A ll 

A 21 

' . 1 
A 31 


X 

s 

3.20 

y b 

= 

A 12 

A 22 

A 32 


Y 

s 

3.21 

Z B 

- 


A 13 

A 23 

« 1 
CO 

c 


Z 

s 


- *V R 3 

- *V R s 
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APPENDIX B 


AN EXPLANATION OF THE SYMBOLS USED IN THE DIGITAL 
PROGRAM TACS AND A REPRESENTATIVE PRINTOUT OFTACS 


SYMBOL 

DEFINITION 

A (i, j) 

elements of the direction cosine matrix 

AO 

attitude error gain 

A1 

angular rate gain 

AD (i,j) 

rate of change of the elements of the direction 
cosine matrix 

ADP (i, j) 

value of AD(I,j) during the previous computa- 
tion cycle 

ALT 

altitude of the vehicle in nautical miles 

AMASS 

mass of the vehicle 

APOGEE 

apogee of the orbit 

AREF 

aerodynamic reference area 

ARUN 

conversion of RUN into seconds 

AT 

the aerodynamic angle of attack 

ATIME 

a time used in the print loop to determine how 
often to print 

AXIS 

one -half the major axis of the orbit 

C <i,j) 

elements of the command matrix 

CA 

aerodynamic coefficient 

CAO 

aerodynamic coefficient 
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SYMBOL 


DEFINITION 


CF.., 

ijk 

engine on time (cumulative) 

CL 

aerodynamic coefficient 

CLCG 

aerodynamic coefficient 

CN 

aerodynamic coefficient 

CNO 

aerodynamic coefficient 

CONV 

a conversion factor equal to the number of 
degrees per radian 

CSM 

aerodynamic coefficient 

CSMCG 

aerodynamic coefficient 

CSMO 

aerodynamic coefficient 

CSN 

aerodynamic coefficient 

CSNCG 

aerodynamic coefficient 

CVX 

aerodynamic coefficient 

CY 

aerodynamic coefficient 

D (i,j) 

elements of the attitude error matrix 

DB 1, 2, 3 

three deadbands available for use (multiples of 
epsilon) 

DELTX, Y, Z 

command torques derived from attitude error 
and angular rate signals 

DELTYO 

main engine command torque 

DELTZO 

main engine command torque 

DREF 

aerodynamic reference length 
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SYMBOL 


DEFINITION 


DT 


time increment 


DTL 


DTS 


EPDX, Y, Z 
EPDDX, Y, Z 


EPDDXP, YP, ZP 


EPSLN 


ETA 


FMTX, Y, Z 
FMXCG, YCG, ZCG 
FPDX, Y, Z 
FPDDX, Y, Z 
FTX, Y, Z 
G 

GO 

GDC, Y, Z 
OKY, XZ, ZY 


normal time Increment 

time Increment during engine burn (equal to 
minimum on time) 

angular rate due to inertial cross coupling 

angular acceleration due to inertial cross 
coupling 

value of EPDDX, Y, Z during the previous 
(computation cycle 

deadband value tor attitude control 

.angular position of vehicle in orbit relative to 
an arbitrary reference lpoint 

engine name and thrust level during a (computa- 
tion cycle 

total torque due to engine bums 
torque due to aerodynamics 
angular rate due to engine torques 
angular acceleration due to engine torques 
total (engine thrust in each axis 
gravitational -acceleration at altitude h 
gravitational -acceleration at sea level 
.principal moments of inertia 
cross products of inertia 
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SYMBOL 


DEFINITION 


GMGX, Y, Z 

gravity gradient torques 3 

GMU 

gravitational constant 

GMU.lt 

‘ gravitaldonal parameter used ir. ; alculating 
gravity gradient torques 

GPDX, Y, Z 

angular rate due to gravity gradient and 
aero torques 

GPDDX, Y, Z 

angular acceleration due to gravity gradient 
and aero torques 

GPDDXP, YP, ZP 

values of GPDDX, Y, Z during previous 
computation cycle 

H 

altitude above sea level 

; . ■ ( 

IACT. 

ijk 

number of engine actuations for each engine 

ISUM1. 2 . 

parameter used to determine if an engine has 
fired (for printout purposes) 

J... '.• 1 ■■■! : - 

Uk 

logic element in engine firing logic 

NISUM 1, 2 

parameter used for engine actuation printout 
purposes 

ORTHO i, 2, 3 

an orthogonalization parameter 

PDX, Y, Z 

vehicle angular rates 

PDDX, Y, Z 

vehicle angular accelerations 

PERIGEE 

perigee of the orbit 

PERIOD 

period of the orbit 

PHI 

aerodynamic roll angle 
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SYMBOL 

PI 

PPDX, Y, Z 

PRINT 
PSIX, Y, Z 
Q 

RDT 

RHO 

RS 

RUN 

T, Tl, T2 

TEST 

TIME 

TMX, Y, Z 
TT.i, 2 r ■ 
VPDX, T, Z 
VS 

XB, YB, ZB 


. DEFINITION r 

7r , constant 

values of PDX, Y, Z during previous computa- 
tion cycle ' - 

determines the; time between print cycles 

. attitude error signals ' 

initialization constant to avoid dividing by a DT 
of zero during the first computation cycle 

ratio of DT to the previous DT 

. atmosphere density at altitude h 

distance in inertial reference system from the; 
center of the earth to the center of mass of the 
vehicle 

sets the time the vehicle will orbit 

the RCS thruist level, T, and two multiples 
of it, if needed 

used to choose between normal DT and minimum 
..on time DT. . 

time (vehicle, not real time) 

sum of gravity gradient and aerodynamic torques 

parameter used in calculating engine on time 

initial angular rates 

vehicle velocity in the inertial reference system 
body axes 
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SYMBOL, 


DEFINITION 


XGG 

distance from center of mass to geometrical 


center along X axis 

XDB, YDB, ZDB 

rates; in body axes 

XDDB, YDDB, ZDDB 

accelerations in body axes 

XDDSF, YDDSF,, ZDDSF 

transforms of body accelerations to inertial 
reference system 

XDDSG, YDDSG, ZDDSG 

acceleration due to gravity in inertial reference 
system 

XDDSP,, YDDSP,, ZDDSP 

values of XDDSG, YDDSG, ZDDSG during the 
previous computation cycle 

XDS, YDS, ZDS 

vehicle velocity expressed in Hie inertial 
reference system 

XDSP, YDSP, ZDSP 

values of XDS, YDS, ZDS during the previous 
computation cycle 

XfMP’ 

absolute value of disturbance impulse in X axis 

XS, YS„ ZS 

inertial axes 

YOG 

distance from center of mass to geometrical 
center along, Y axis 

YIMP 

absolute value of disturbance impulse on vehicle 
in Y axi s 

ZOG 

distance from center of mass to geometrical 
center along Z axis 

ZIMP 

aboslute value of disturbance impulse on vehicle 
in Z axis 
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PROGRAM TACS 

D I MBAS I ON N1<4>,N2(4J,N3<4>.N4I4>.N5<4>,N6(4>,N7(4>,N8(4>,N9<4> 
DIMENSION AO ( ji 3 ) , A ( 3 . j ) , ADP ( j ) ■ C ( j, j ) i D ( 3 . 3 ) 

READ 67. N1.RE,N2.Q0.N 3 , AMASS, N 4 ,Pl,N5,C0NV.N6.T. N7.r0, NB.GJX 
■ pRlNl 67,Nl,RE,N2,G Q ,N3,AMAsS.N4,pI,N5,CnNV,N6,T,N7,r 0 ,N8,GIX 

READ 67,Nl,GlY,N2,fi!Z,N3.GIZY,N4.GIXY,N5,GIXZ,N6,YCll,N7,YCL2 
PRINT 67,Nl,GIY,N2,aIZ,Nj,G!ZY,N4,GIXY,N5iGIXZ,N6 ( YCl.l,N7,YCL2 
READ 67, Nl, ZCL1, N2, ZCL2 , Nj, Xl, NA, X2, N5 , X3, N6, X4 , N7, X5, N8, X6, N9, X7 
PRINT 67,Nl,ZCLl,N2.ZCL2,N3,Xi,N4,X2,N5,X3,N6,X4'.N7,X5,N8,X6,N9,X7 
READ 67.N1,X8,N2,X9.N 3 ,Y2,N4,Y 4 ,N5>T6»N6,Y8.N7,Z1,N8,Z3,N9,Z5 
PRINT 67,N1,X6,N2,X9,n3,Y2,N4,Y4,N9,Y6,N6,y8,N7,Z1,N8,z3,N9,Z5 
REAO 67,N1.Z7,N2,RS I N3,XB,N4.YB,N5,ZB,N6,XS,N7,YS > N8,ZS,N9,XDS 
PRINT 67,N1.Z7,N,,RS,N3,XB,N4,Y8,N5»ZB,N6,XS,N7,YS,N8,ZS,N9,XDS 
rEAD 67,Nl,YDS,N2,ZDs,N3,XDDS<N4,Y00S,N5,ZDDS,N6,EpSl.N ( N7.DECTY a 
PRINT 67.N1.Y0S, N2,ZDS,N3,XDDS,N4.YDDS,N5,ZDDS,N6iEPStN,N7,0EtTYG 
READ 67, Nl , DElTZO, N2, PDX, N j, PDY ,N4,PDZ,N5,GPDx,N6.GPDY»N7,GP0Z 
prINt 67, Nl, DELTZO, N2,pDX,N3,p0Y,N4,pDZ,N5,GpDX,N6,GpDY,N7,GpDZ 
READ 67,Nl,rPDX,N2,rPDY,N3,rPDZ,N4,PDDX,N5,rDDY,N6,PDDZ,N7,GPD0X 
PRINT 67.Nl.rPDX,N2,rPDY,N 3 ,rPDZ,N4,PDDX,N5,PDDY,N6.PDDZ.N7.GPDDX 
rEAD 67,N1,G p DDY,N2,G p DDZ,N3, AO.NA, A1 ( N9,DTs,N6,DtL.N7,AbRINT 
PRINT 67,N1,GPDDY,N2 1 GPDDZ,N3.A0.N4,A1,N5,DTS,N6,0TL,N7iAPRINT 
REAO 67.N1.RUN 
PRINT 67.N1.RUN 

read soo.crii.criE.criA.cFzi.crzB.crzd.crsz.crss.ersA.crAi.cFAs.cF 
1 4 4 

READ 900,CF35,CFS6,CF58,CF65,CF66.CF67,CF76,CF77,CF78,CF85,CF87,CF 
188 

67 FORMAT (1X,4A4,2X.F15 5) 

500 FORMAT (1ZF4.1) ' 

D 0 »C1 1.1,3 

DO SCI J.1.3 

*<ll'.»»0.0 

501 AOII.UI.O.O 
A(1,1)«.1,0 
A<1,2)«0.0 
A(l,3)»0.0 
A ( 2 , 1 ) *00 
A(2, 2)«41.0 
A (2. 3 ) *0 , 0 
A(3,l)«0,0 
A ( 3 • a > ■ 0 . 0 
A(3,3)*1.0 
vIMP.0.0 

yimpao.o 

ZIMP.q.O 

xoosa« 0<0 

YDDS0»0,0 

ZDDSC‘q.0 

7UM8L6=0iSS2l9789/CONV 

DELTX.O.O 

DELTY«0,0 

deltz »0 . 0 

0"»2. 

TIME. 0.0 
ATIME« 0 .0 
PRtNT»o.o 
DT»0.0 
TEST. 0.0 

GMU.c.3986o379E»l5 
ETA. c.o 




APOGE£i250,0 

PERlG£Eil40,0 

*X I Si (2, •RE*1852,. (APOGEE ♦PERIGEE) ) 22 
PER(CD«2.«P|*SGRT(AX1S*AXIS*AX)S/GMU) 


CF22l»0,0 
Cr 223*0 ■ 0 
CF44i*o,o 

CF 44J*o # 0 
PDX»F DX/cONV 
PDY*P (JY/CONV 

poz«fdz/conv 

PDDXiPDDx/CONV 

pddyiPddy/conv 

PDOZiPODZ/CONY 

GPOXiGPDx/CONV 

GPOYiGPDY/CONV 

GPOZiGPDZ/CONV 

GPOD>*GPDDX/CONV 

GPDUY*GPDDY/CONV 

GP002*QPDDZ/CONV 

FPDXiFPOX/CONV 

FPDYiFPDY/CONV 

FPOZiFPDZ/CONV 

DE(.TyO*DELTYO/CONV 

DEL TZO*DELTZO/ CONY 

EPS1MEPSI.N/CONV 

NISUA^O.O 

n I9U*2*0.0 

ARUNiRUNi«0,0 

vpnxipox 

VPDYiPDY 

VPDZiPDZ 

DBl*EPSLN 

DBSitBi 

DB2*) ,5«DBl 

n*r 

T2*10*T 

EpOXiO.O 

EPDY.0,0 

EPOZiO.O 

EPOU»«o.o 
EPDD> *0 i o 
EPDDZ«0.0 

HiRS.RE 

AlT*X/l8S2. 

RHO*, ,9522S23E*08«EXP(*ALT«,(lA 1 755> 

XCG.1,826 

YCG,. ,005718 

ZCQ*> i 06538 

DRGF i2 *5399 

AREFi3,i4i59 2 6*0REF«0REF74, 0 

XD8«0,0 
YOB»7807,73 
ZOB»0 ,0 

t ACTS 1*0 , 0 
I ACTJ3*0 a Q 
IACT41*0,Q 
IACT43»o,o 
IACT<21<0<0 



c 

c 


IACT223«0,0 
IACT«41»o,0 
(ACT443«o.O 
I ACT ll«t3 , 

I ACT 2 2«Q . 

iactj3»o. 

IACT44«0. 

I ACT 1 4»o , 
1ACTJ3.0. 

1 ACT32«0. 
IACTAl»o. 


69 CONTINUE 

LOG 1C CONFIGURATION 1 (ONE).,, 

J21«(O6ltX«OELTY-DBi*10 0 .)/100-' 

J221* I *UEt TX-0ELT2- 08,4,0 0, >7,00, 
J22i*(D£LTX-DeLTZ'DBl*10O,)/lBO, 
J23«<*0 ElTX-OELTY-OB1*100, 1/100, 

J4, a < "OElTX^OELT V*OB, 0 0 , ) /,0 0 , 
J4il«(DELTX«0£LTZ-DBl*100. )/IOC. 
J443i(-OEl.TX»DELTZ-DBinOO, 1 / 100 , 
j43«(0ELTX-0ELTy-DB,*, 00, )/,00, 

F210.21.T 
F23».23,T 
f4ia.4 1 .T 
F43«»43*T 
F 22^®^22^*^ 

FZ23i J2Z3*T 
F441.J441.T 
F443«g443*T 
FTX«C,0 

FTY«F441*F443.F221-F223 

FTZ„F23*F43-F2l4F41 

PTESTaTESl 

TEST4F2i,F23*F4i.F43*F22i*F223*F441*F443 

RS«SCRT<XS*XS4YS«YS*ZS*ZS> 

GaGO« <R6/KS)*<BE/RS> 

Ha«S-RE 

VS«SCRT(xDS*XDS*YDS*YDS*ZOS4ZdS) 

pdtoct 

I F < 0 > 57,57,133 
1 33 IF( TEST ) 56 , 56, 55 

55 DToDTS 

I SUMl »0 0 

ISUMJ»FSl*F23*F41*F43*r22l*F223*F441*r443 

misufi«nisuhi*isumi 

N|$UF29NlSUh2*ISUH2 

TTl a CT/Tl 

TT 2 "CT/T 2 

CF 2 1 .CF 2 1 *(F 2 1 «TT 1 1 

CF23«CF 2 3*(F 23 .ttI) 

CF41aCF4i*(F4l.TTX) 

CF43,CF43.(F43.TT1) 

CF22laCF221-»(F221*m) 

CF 22 i»CF 2 23*(F223*FT1) 

CF44laCF44l*(F44l*TTl) 

CF443,CF443* ( F443*TT1) 

GO TC 57 

56 OToOTL 


57 0*2, 

T I Mb* T I HE^DT 
HDT«C T 72 , 0 


00 

00 



IF (PtT)134. 134.135 

135 ROT-tT/PDT 
GO TC 136 

134 RDT»CiO 

1 36 CONTINUE 

FMTX«1.5*<F23.F2i>*l,485*<F41-F43)*,233*(F443*F223>*.376«(F22l*F44 

11 ) 

FMTYi6,567*(F23*F43.F21.F41) 

FMT2*6,567*(F221*F223*F44i.F443) 

[ACT 2 1«(<V,»-DT*PDT)/10, > * Jol* I ACT 2l 
IACT238((9,«-DT*pDT)/10, ).J23 *IaCt23 
I act 4 1« < (V.V-UT^PDTI/IO, ),J41*IACT41 
I ACT 4 3” < (»,9-OT*PDT)/l 0 , ).J43*IACT43 
IACT 22 1*( <9,9.DT*pDT>/10. >*J ? ,1*I ACT 22 1 
IACT<23 o ( ( 9,9.DT*pDT>/10. ) * J223* 1 ACT223 
I ACT 4 41* ( (9,9-DT‘PDTJ.lO. ) . J441 * I ACT441 
| ACT 4 43" ( (9,9.DT*pDT)/i 0 . ) ♦ J443* 1 » C T443 
GMULT"3,0*GMU/(RS*RS*RS*RS*RS) 

GMGX4GMULT»(<GIZ-GlY)*Y8*ZB*GIZY*<ZB*Z8-YB*YB)*GIXY*X8*Zfl*GlxZ*XB* 

IrB) 

GMGY>GMULT*( (GIX-GlZ)*ZB*xB»GIXZ*(XB*XB-ZB*ZB)*G|ZY*YB»X8.GlXY»YB* 


1ZB) 

GHGZ*GMULT*((GIY-GIX)*XB*YB*GIXY*(YB*YB»XB*XB)*GIXZ*ZB*Y8.G1ZY*ZB* 

1X8) 

XIHP«XIMP*DT*ABS(GMGX) 

YIMP. YIMP*OT*ABS(GMGY) 

ZIMP«ZIMP*DT*ABS(GMGZ) 

FPOti>»FMTX/GlX 

FPDUY oFMTY/G I y 

FPDUZbFMTZ/UIZ 

gpduxPoGpoox 

gpduypoQpody 

gpduzp.gpuoz 

PH 1 b a TNB ( YOB. ZDB ) 

CVXoxDB/vS 

|F(AES(CvX)-l, 18.7.8 

8 AT=pI/2.-(CVX*CVX*CVX*CVX/6.*3,*CvX»CVX»CVX»CVX»CVX/4I),*15,*CVX*CV 
lx.cv* .CVX.CVX.CVX.CVX/336, ) 

GO 1C 10 
7 AT"0,0 
10 CONTINUE 

CAOo; ,77i2l*COS(AT)-l,757o6*CoS(3.*AT)».40363«COSI5.*AT).,08961*CO 
1S(7,4AT)»,04«89*COS(9,.AT) 

CN u »E ,77 i 65*SIN( AT)-,9627i*slN(3.**T)-,34303*SIN(5,*AT)*,l!2238*SIN 
l(7,*AT)*,no a 89*SIN(9 l *AT) 

CSHO«l4,88051*SIN(AT).I,6028*SIN(3i**T>»i54l78*SlN(5,*AT)«,00297*S 

1IN(7,*AT)-.01482*SIN(9.»AT) 

CAbCAO 

CNbCKO*COS(PHI ) 

CYb-CNO*SIN(PHI ) 


ClnO.O 

CSH = CSM 0 .C 0 S(pH| ) 

CSNb-CSMO*SIN<PHI ) 
CSHCC«CSM*CA*ZCG/DREF-CN*xCG/DRE f ' 
CSNCGBCSN*CY*XCG/UREF *CA*YCG/DREF 
CUCUiCU*CY*ZCG7DREF*CN*YCG/OREF 
alt»f /IB s? . 

RH 0 B,2068E-05.EXp(-,3805E.06*(ALT**lT**LT- 
16*AL1 ) ) 


,7774E03*AUT*4LT*»2911E0 

NOMINAL 


0«.5*RH0*VS*VS 

fmxcc*o*aref *uref*clcg 
fmycg«q*aref*oref*cshcg 


CO 



FMZCG*0*aR£F*BREF*CSNcG 

tmx»gmgx*fhxcg 

TMY*CMQY*FMYCa 

TRZ*GRGZ*FMZC0 

GPDB»«TMX/0|X 

GPD0Y«TMY/01Y 

GPDD2»TMZ/GrZ 

EPDOxP.EPODX 

EPOByP.EpODY 

EPDB1P»Ep.0D2 

EPBB>*( (pDX«PBY*PBD2I»GIXZ-(GIZ.GI Y) ♦PDY»PD2 )/G| X 
EPDBY«( (GI2*G[XI»PD2*PDX*<PDZ«PD2-PDX«PDX)*GIXZ)/GI y 
EPDB 2"((GlX-GIY)»PBX*PDY*(PBDX*PBY*PD2l«OIX2)/GJZ 
EPDX*EPBx*BT*(EPDBX*< <EPDDX.EpDOXP)/ 2 , >*RDT> 
EPDY*EPDY*DT*<EPDDY*<(£PDDY.£pDDYP>/ 2 , )*RDT) 
EPD2»EPBZ*DT*(EPDBZ»<(EPBDZ»EPDB2P>/ 2 ,)»P0T) 

fpdx«fpbx*bt*fpddx 

fpdy«fpby*ot*fpbdy 

fpdz*fpbz*ot*fpbdz 

GPDX>GPBX*flT*<GPDBX«< (GPD bX»GPDDXP>/ 2 i >»«DT> 
GPBrtGPBY*BT«(GPDBX*<<QP0BY*0PDBXP>/ 2 t)*RBT) 
GPDZ«8P0Z*DT«(GP0 DZ'»< <QPBbZ*OPDBZP)/ 2 i >«ROT> 

PPDXtPBX 

PPOY«PBY 

PPDZ*PDZ 

PBX«FPBX«GPBX»VPDX*EPBX 

PBY«FPBY*aPBY*VPDY«EPOY 

PBZ«FPBZ*aPBZ*VPDZ*EPBZ 

PBDX*FPBDX»QPBDX*EPBDX 

pbdy*fpbby*gpbby«epbdy 

P0nZ»FPBDZ*aPBDZ*6PBB2 
DO St I»1,J 
DO 9* J*l,j 

98 ADp<l,J)«A0<I,J) 

A0(l,X)»A<l,2>.PDZ*A<l,3>.PDY 

A0< 1 ,21«A<i.3)*PDx-A<j,,i>*PDZ 

, A0(1.3>«A(1.1)*PDY-A<1, Jl.PDX 
AB(2iI)"A(2j2)*pDZ"A(2»3)*pDY 
ABt2.2)«A(2*3)*PDX.A(2il)«PBZ 
AB(2, 3)*A<2.1)*PDY*A<2,2>.PDX 
A0( 3 .1>»A< 3 .2)*PDZ.A< 3 , 3 >«PDY 
AB(3,2)>A(3i3)*pDX-A<3,l)*pBZ 
AD(3.3UA(3»1)*PDY.A(3 i 2)*PDX 
DO 99 I all 3 
DO 9t Jtl, 3 

99 A( l(i,’)«A( I. J)*DYM*0< I. JW(AD( I. J)«ADp<|« J))«RDT/2,> 

A(2,l)«A(l,3)*A<3,2|.A(l, 2 |,A(3,3) 

A( 2 «j)»A<iii )»A(3,3)'A(,,3>*A(3ii» 
A(2.,)«A{l,2)«A( 3 ,l)-A(I,l)*A( 3 ,2) 
A(3,1)»A(1,2)«A(2,3).A(1,3)*A(2,2) 

A C 3, S ).A(1.3).A(Z,1)*A(1,1)«A(2.3) 
A(3.3)>A<1.1)*A<2.2)«A<1>2)»A(2.1> 

QRTHa*SaRT(A(l,l)*A(X,l)»A(l,2)*AUi2)««(li3)*Aa.3)) 
0RTMC2 «SoRT(A(2,1)*A(2,1)*A(2,2)*A(2i2)‘A(2i 3)*A(2,3) 1 
0RTHC 3 PSoRt(A( 3# l)«A( 3 ,l)*A(,,2)«A< 3 #2)*A< 3 i 3 ).A( 3 , 3 l ) 
A<liJj»A ( li 1 > /OpTHOl 

A<i,a>«Aci,a>/oRTHOi 

A(l,,)*Aa. 3 )/0RtH0l 

A(2«I)pA(2«1)/qRTHq2 

A.a,2>»A,2,2>/ORTHB2 

Al2,3)*A(2,3)/0RtH0 2 


in 

cn 



c 

c 

c 

c 


i 1 J/0RTH03 
i 2 ) /ORTH03 

thI'^mat^u'is^th^guiounce matrix and the position errors are obtained 


A(3,l )*A(3 
* (Si a >>A(3 


PROM THE D MATRIX, 


ZB ALONG ZS, YB IN ORBITAL PLANE, XB PEP, 
Cllil)»*i.O 
C( l. J I »0 , 0 
C( li 3 ) "0 . 0 
C ( 2, 1 ) *0 0 


cia.s 

C(2#3).0,J 
c( 3# 1 >» 0 , 0 
ci j.J)»o,o 

C(3.!)«l,0 
DO 60 1*1,3 
DO 60 J*1 , 3 

60 0Ut<. >«C(l.l)iAU.J>*C(2, t)*A<2.J»*C<3.l>**<3«J! 
pS!X> 0,5«(D(3,2>-D(2,3) ) 
PSlT«0,5.tD(i,3 ) .D(3,l )) 

PS!2> 0 ,5«(0(2,i>-D(i,2) ) 

delt»»ao.psix*ai*pdx 

DELTT«A0.pSlY*Al*pDY 

delti*ao*psiz*ai*pdz 

deltyo-delty 

deltzo*deltz 


c 

c 


XD08.FTX/AMASS 

yddb.fty/Amass 
ZDDB.FTZ/AMASS 
‘XDDSP iXDDSQ 
yddsp iYDDSQ 
ZDDSP iZDdSG 

XDDSP • A ( l , 1 ) *XDDB»A (l,2l*YDDB*A(i,3)*Z0D8 
yDDSPAA(2,1)*xDDB.A(2,2)*yOD8.A(2. j)*ZDDB 

T00sF«A(S,i)*X00B*A(3,2)«YDDB*A(3,3)*.Z0DB 

XDDS0**G*XS/RS 

ydoso»-g*ys/rs 

ZDDS0*-G.ZS/RS 
XDSPiXDS 
YOSPiYOS 
ZOSPi zos , 

XD9*»DS*OT*XDDSF*OT*(XOOSQ*((XDOSQ.XOOSP!/2,>*RDT) 
YDS«YDS*DT*YDDSF»DT*(YDDSG»( (YDDSG-TDOSPI/j, )«RDT) 
ZDS»ZUS*DT«ZDDSF*DT«(ZDDSG*( (ZDDSG*ZDDSP>/j, )*RDT) 


XSiX5«HDT*(XDS*XDSP) 

YS*YJ*HDT*(YDS*YDSP> 

ZS»ZS*H0T«(Z0s*ZDSP) 

XB. A(1,1)«XS*A( 2 .1)*YS*A(3,1>«ZS 

YB* A(1,2)*XS*A(2»2)*Ys*A(3,2)*Zs 

,8. A(1.3>«XS*A(2,3>*YS*A(3,3>* Z S 

XDBlAU,i)*XDS*A<2,t)«YBS*A(3,l)»ZDS 

YDBiA(1,2)*XDS*A(2,2>*YDS»A(3.2)*ZDS 

ZDB«> (1,3) *XDs*A( 2,3) *YDS*A( 3,31 *ZDs 

ETA»(VS*DT/RS)«ETA 

ATIMOiATIME.DT 

I F ( at I he- PRINT) 69,70.70 


70 AT|ME«0,0 
pRl N T*ApRl N T 
DEOIiETA.CONY 


CO 

CO 



t> 

co 


DEG2*PS J X*C0nv 

D£Q3«PSIy*C0NV 

DE04* PS l Z*CQNV 

DEQ5«DELTX*C0NV 

DEQ6«DELTY*C0NV 

D£Q7*0ELTZ*C0NV 

DEQ8«P0X*CONV 

DEQ9»PDY«C0NV 

DEG10«POZ»CONV 

DEQU*AT*C 0 NV 

DEQ12 *PH I *C0NV > 

PRIM 600,TIME,XS,X8,DEG5,TMX,GMGX,G,YS,YB,DEG6.TMY,GMGY,H.ZS,ZB,D 
1EG7,7MZ,GMGZ,VS,XDS,DEG2,DEG8,FTX,RS,YDS,DEG3,DEG9,FTY,DEG1.ZDS,DE 
2G4.DEG10.FTZ, PERIOD 

600 FORMAT!//, ax, 4 HTIME.2X,Fl2, 3 , 5 X.2HXS,4X.Fl2 l3 ,5X,2HXB, < |-X l Ft2. 3 .5X 

l,5M0ELTX,iX,F7,3,5X J 3HTMX,3X,F12,6,5X,4MGMGX,Fl2.6, / ,lX,lHG,5X,Ft2 
2,3,5>,2HYS.AX,F12.3,5x,2HYB.4x,F12,3,5x,3HPEl.TY#lX,F7 1 3|5x,3MTMY,3 
3 X.F 12 . 6 « 5 X < 4 HGMGY,Fl 2 , 6 #/.lX,lHH.gX,F 12 . 3 , 5 X, 2 HZS» 6 X<Fl 2 , 3 . 5 X< 2 HZB 
4,4x,F12,3,5x,5H0ELTZ»lX,F7 t 3,5X < 3HTMZ,3X,Fi2,6,5X(4HGMGZ ( F12 1 6,/,l 1 
5X,2MVS,4X,F12,3»5X,3HXDS,3X.F12.3,5X,4HRSIX,2X,F12,3,5X,3HPDX,1X,F 
69,5»“X,3 HFTX m X,F12 1 3,/,1X#2HRS,4XiF 12, j j 5 X ( 3 HY0S»3X,Fl2,3,5X, <t HPS 
7lY.2>,Fl2 l 3,5x,3HpDY,lX',F9.5,5X,3HFTY,3S,Fl2,3 ( /,lX,3HETA?3X,Fi2 l 3 
8 J 5X < ’HZ0S,3X,F12.3,5X J AHPSIZ,2X,F12,3,5X,3HPDZ 1 1X ) F9,5,5X < 3HFTZ,3X 
9,F12,3,5x»6HP£Rlbb»F8,2) ) 

PRIM ftO^DEGU/DEGia.FMXCG.FMYCG.FMZCG 

601 F0 R MAT(23X,5HALpHA,2X,Fil,A,5x.3H p HI,4X,Fll,4,5X.5HFMXCG,F12,6,5x» 
15HFMyCG,F12,6.5X.5HFMZCG.F12,6> 

PRINT 6358 .XIMP.YIMP.ZIMP 

6 3 58 FORM A T ( IX, 10HX IMPULSE*, Ell, 4 , 5 X 1 IOHY I MPULSE4 , Ell , 4 , 5 X . 10HZ JMPUL 

lSEs* E 11 , A, / ) 

IF (MSUMl)lOOO, 1000, 1001 

1001 PRINT 1005,CF11,CF14,CF22.CF23.CF3Z.CF33,CF«1,CF44 

100 5 FORMAmHO, 5 HCFlls,F 6 . 3 , 8 H CF 1 4 « , F 6 , 3 , BH CF22* , F 6 . 3 i 8 H CF 2 ..S 

1 , F 6 , 3 , 8 H CF32= , F6 , 3 , BH CF33» , F 6 , 3 , 8 H CF 41 » , F 6 , 3, BH CF44s,F 

26, 3 > 

PRINT 7359, IACT11, IACT22, I ACT33, I ACT44, I ACT14, I ACT23, I ACT32, IACT41 

7 3 59 FORM A T ( lx , sMACTll , 1 5 , 8 H ACT 22 .I 5 . 8 H ACT 33 ,I 5 , 8 H ACT 44 .I 5 . 9 H 

1 ACT14.15.9H ACT23.I5.9H ACt32.15.9H ACt41.I5J 

10 00 IF (MSUM2)1003, 1003, 1004 

10 o4 PRINT loo 6 .CF2 1 ,CF23»CF 2 2 1 ,CF223,CF4 1 ,CF43,CF44i,CF443 

1006 FORMAT<lHO,5HCF21s,F6, 3 ,8H CF2 3 » , F6 , 3 . 8H CF 22l« , F6 , 3 * 8H CF22 3 = 

1.F6.3.8H CF41«,F6,3,8H CF43«, F6 , 3, 8H CF44ls , F6 , 3. 8H CF443»,F 

26,3) 

PRINT 7358, IACT21.IACT23, IACT41, IACT«3, JACT221, IACT223. JACT44;, I AC 

7358^FqrSaT(1x,5HACT21, 15, 8 H ACT 23 .I 5 . 8 H ACT4l.I5.8H ACT43.15.9H 

1 ACT221.I5.9H ACT223.I5.9H ACT44l.J5.9H ACT443.I5) 

100 3 CONTINUE 
N 1 SUM 1*0 
NI9UM2-0 

2047 CONTINUE 

IF(TIME»ARUN)69, 73,73 
7, STOP 
' .end. 
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